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Part II 

APPLICATION OF FINITE-ELEMENT METHODS TO DYNAMIC 
ANALYSIS OF FLEXIBLE SPATIAL AND CO-PLANAR 
LINKAGE SYSTEMS 

Steven Dubowsky 

The following figures describe an approach to modeling the flexibility effects 
in spatial mechanisms and manipulator systems. The method is based on finite- 
element representations of the individual links in the system* However, it 
should be noted that conventional FEM methods and software packages will not 
handle the highly nonlinear dynamic behavior of these systems which result 
from their changing geometry. In order to design high-performance lightweight 
systems and their control systems, good models of their dynamic behavior which 
include the effects of flexibility are required. 


FOCUS 

• DEVELOP PRACTICAL AND EFFICIENT METHODS WHICH 
ANALYZE SPATIAL MECHANISMS AND MANIPULATORS 
CONTAINING IRREGULARLY SHAPED FLEXIBLE LINKS 
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The method presented here for the modeling of the dynamic behavior of manipu- 
lators and machine systems with flexibility is based on using individual 
finite-element link models to reduce the number of dynamic degrees of freedom. 
The system gross motion is modeled using 4 by 4 matrix methods. The resulting 
equations of motion contain both the full nonlinear behavior introduced by the 
system's gross motion and the effects of link flexibility. 


ANALYTICAL APPROACH 

• 4 x 4 MATRIX DYNAMIC ANALYSIS TECHNIQUES 

• WELL-ESTABLISHED METHOD 

• APPLIED TO RIGID LINK SYSTEMS IN PREVIOUS WORK 

• POSSIBLE TO EXTEND ANALYSIS TO INCLUDE FLEXIBILITY OF LINKS 

• FINITE-ELEMENT METHODOLOGY 


• USED EXTENSIVELY IN STRUCTURAL DYNAMICS 

• STANDARD FINITE-ELEMENT PROGRAMS (NASTRAN, SAP, ETC) 
ARE WIDELY AVAILABLE 

• PERTURBATION COORDINATES 

• COMPONENT MODE SYNTHESIS COORDINATE REDUCTION 
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This figure defines the well-known 4 by 4 coordinate transformation. These 
transformations contain the information that describes the kinematic con- 
straints imposed by the systems joints or connections. 


4x4 MATRIX NOTATION 
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The vectors representing any point in the system can be represented to a 
common frame using 4 by 4 methods. In particular, the inertial position of 
any point can be described. 


4x4 MATRIX ANALYSIS 
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The position variables of the finite-element grid points must be transformed 
into 4 by 4 notation. 


LOCAL GRID POINT MOTION 



LOCAL POSITION: 

NP(i) 

'jg* I *ig0 p i0 +b ig 
0=1 

NOMINAL POSITION: 

b ig“ ll x igTjg z ig^ T 

SELECTION VECTOR: 

*igp * fO1OOj T for0= 1 + 6(g-1) 
= fOO1Oj T for0* 2 + 6(g-1) 
» 1 0 0 0 1 ] T for 0= 3 + 6{g-1) 
= [ 0 0 0 0 ) T for all other 0 


463 



The inertial velocities of the grid points are calculated in 4 by 4 notation 
so that the kinetic energy (next figure) required by Lagrange’s Equations 
(following figure) can be formulated. 


GRID POINT INERTIAL VELOCITY 

• INERTIAL POSITION: 

r ? = T * r- 
ig 'o’lg 

• INERTIAL VELOCITY: 
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LINK ENERGY 


KINETIC ENERGY 
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LINK DYNAMIC EQUATIONS 

• LAGRANGE'S EQUATIONS 
dt 

• LINK DYNAMIC EQUATIONS 

m i Pi + 9j Pj + kj Pj =f j 
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The number of degrees of freedom for each link is reduced using component mode 
synthesis in order to achieve good computational efficiency* 


COMPONENT MODE SYNTHESIS 


• CMS TRANSFORMATION 



• REDUCED LINK DYNAMIC EQUATIONS 


Mj a'j + Gj a { + Kj aj = ff 
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The link dynamic equations are formulated in terms of selected global 
coordinates. 


GLOBAL EQUATIONS OF MOTION 

• GLOBAL TRANSFORMATION 

a; = Bj (0(t)) q 

• GLOBAL DYNAMIC EQUATIONS 

M 10) q + G ( 0,0 ) q + K (0.0,0) q = 0 10,0,0. t) 
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This method has been automated in a software package called SALEM (Spatial 
Analysis of Linkages with Elastic Members)* 


SALEM ANALYSIS PROCEDURE 


NASTRAN PREMAP MAP POSTMAP 

4 ■- A - - - > t ~ 1 f — 
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A special version, tailored for robotic manipulators, has also been created. 
This package is called FLEXARM (FLEXible Analysis of Robotic Manipulators). 
These programs include computer graphics output capabilities to assist the 
designer in visualizing, and hence, understanding the complex three- 
dimensional dynamic behavior of these systems. This figure shows the FLEXARM 
compu ta ti ona 1 s t r uc tur e . 


NASTRAN, STARDYNE. ETC. FLEX-ARM PROGRAM 
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Examples of the results which may be obtained using this technique are 
presented. First, a machine system will be considered and then results for a 
robotic manipulator will be presented. 

This figure shows a co-planar mechanism. Even though its kinematic structure 
is planar, it will exhibit spatial vibrations because of the off-sets in the 
links. 


CO-PLANAR MECHANISM 
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This figure shows the details of the FEM model for the coupler link. 


OFFSET COUPLER 
FINITE-ELEMENT MODEL 






NORMALIZED DISPLACEMENT 


This is a typical plot of the displacements on the coupler link 


OUT-OF-PLANE DEFLECTION OF LINK 
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The global coordinates of the mechanism are presented here. 


CO-PLANAR FOUR BAR LINKAGE 




This figure shows different views of the deformation of the mechanism in one 
of its positions. This type of plot can be overlayed to create animated 
motions of the mechanisms motion. 


CO-PLANAR 

FOUR-BAR 

DEFORMED 

GEOMETRY 


UNDEFORMED MECHANISM 


DEFORMED MECHANISM 
WITH MAGNIFICATION 
FACTOR OF 10 


Dl. 

(a) Front View 





n w— i 


(b) Top View 




<c) Rotated View 
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CONCLUSIONS 


• A UNIFIED ANALYTICAL APPROACH FOR BOTH RIGID AND 
ELASTIC LINK MECHANISMS IS POSSIBLE 


• EXISTING FINITE-ELEMENT PROCESSING PROGRAMS CAN 

BE FULLY UTILIZED TO REDUCE GEOMETRIC MODELING COMPLEXITY 


• COMPONENT MODE SYNTHESIS COORDINATE REDUCTION 
IS IDEAL FOR USE IN FLEXIBLE LINKAGE ANALYSIS 


• INCREASED UNDERSTANDING OF 3D BEHAVIOR CAN BE 
OBTAINED THROUGH INTERACTIVE GRAPHICS 
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Part III 


Shown below is an an example of the application of the method to a robotic 
manipulator: the Cincinnati MILACRON T3R3. 
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The first step in the method is to develop a standard NASTRAN FEM model for 
each link in the manipulator, including its base and the floor. The forearm 
model is shown below. The model includes such important parameters as the 
stiffness of the manipulators bearings. 
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In this figure the other NASTRAN models of the other links are shown. They 
have 155 grid points and 273 elements. With the degrees of freedom associated 
with the control systems, this unreduced system would have approximately 1650 
DOF's. The computational cost required to simulate this large nonlinear 
system would be very high. However, the results obtained show that the 
structural degrees of freedom can be effectively reduced by CMS, and a total 
system model of less than 72 DOF's will yield high-quality results. 



Complete Model 



Model with Hidden Lines Removed 


Detailed System NASTRAN Finite-element of Robotic Manipulator 
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Frequency response experiments for the manipulator in a number of stationary 
positions show good agreement with the FLEXARM results* It should be noted 
that when the manipulator is nominally stationary, its equations are nearly 
linear and classical frequency response analysis is meaningful* 



Comparison of Analytically and Experimentally Determined 
Serve Val ve-to-Tachometer Transfer Functions for Base Drive 
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PHASE (DEGREES) 






The open-loop control analysis done using FLEXARM shows that the stability 
margins of the system are greatly reduced by the link flexibility. 



Analytically Predicted Open-Loop Transfer Function for Base Control Loop 


PHASE (DEGREES) 


The next group of figures shows the results for FLEXARM simulation of a 
typical large motion manipulator move. 

First, we see the manipulator in its initial position. It will start here 
from rest. This figure is typical of the computer graphics output mode of 
FLEXARM. It will then move to its final position with the tip traveling along 
a straight line in three-dimensional space. 



Rotated View of Manipulator In Workspace 
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Here the several positions of the manipulator are along its straight line 
path* As it is standard for many commercial systems, the manipulator tip is 
commanded to move along its path at a constant acceleration until a constant 
velocity is reached. It then moves at that constant velocity and then at some 
point it decelerates to its final position. 



< 40 , 0 , 0 ) 



As shown here, the joint motions for a simple straight line move are complex 
functions of time because of the nonlinear kinematic transformations. These 
joint angles are required as position inputs to the manipulator control 
systems. The T3R3 is capable of using both velocity and acceleration feed 
forward signals as well. 
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The resulting error in the tip position, measured from its nominal position, 
is shown here as a function of time. Both the response for a '‘rigid" system 
and a flexible system are shown. In both cases there are relatively large 
errors during the acceleration and deceleration phases of the manipulator's 
motion. For the rigid case most of the error can be attributed to the 
compressibility of the hydraulic fluid used in the system's drives. The error 
of the flexible case is significantly larger than that of the rigid case. An 
important aspect to be noted in this figure is that the time required for the 
flexible manipulator to settle within its error specification of 0.25 mm at 
the end of the motion is nearly twice that for the rigid link system. This 
increased settling time can have a very substantial impact on the productivity 
of the system in many practical applications. It might also be noted that the 
results of the studies predict that flexibility of the floor on which the T3R3 
is supported can have a very significant effect on the systems performance. 

In fact, if the floor concrete is less than 4 inches thick, the system can 
exhibit unstable behavior in certain manipulator positions. 
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Currently, control algorithms are not available which will effectively control 
the highly nonlinear dynamic behavior of flexible manipulators. Substantial 
research on this problem is now being done, but it is a difficult problem. 


SOLUTIONS TO FLEXIBILITY PROBLEM 

Short Term: 

Use of new materials and design 

CONFIGURATIONS TO MAKE MANIPULATORS 
LIGHTER - YET MORE RIGID, 

Long Term: 

The development of control systems 

TO COMPENSATE MANIPULATOR FLEXIBILITY - 
AND IDEALLY EXPLOIT IT TO ACHIEVE ULTRA- 
HIGH SYSTEM PERFORMANCE, 
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CONCLUSIONS 


* FLEXIBILITY CAN PLAY AN IMPORTANT ROLE IN THE DYNAMIC PERFORMANCE OF HIGH- 
PERFORMANCE MACHINE SYSTEMS. 

* EFFICIENT AND ACCURATE FEM METHODS CAN BE DEVELOPED FOR THE MODELING OF 
NONLINEAR MACHINE SYSTEMS, INCLUDING ROBOTIC MANIPULATORS. 

* THE CURRENT MANIPULATORS ARE DESIGNED TO AVOID THE PROBLEMS INTRODUCED BY 
FLEXIBILITY. HOWEVER, THIS SIGNIFICANTLY LIMITS THE PERFORMANCE OF THESE 
SYSTEMS. 

* NEW CONTROL SYSTEM ALGORITHMS ARE REQUIRED TO PERMIT THE DESIGN OF 
LIGHTWEIGHT HIGH-PERFORMANCE ROBOTIC SYSTEMS. THESE CONTROL ALGORITHMS 
NOT ONLY SHOULD COMPENSATE FOR SYSTEM FLEXIBILITY BUT THEY SHOULD ALSO 
EXPLOIT IT! 
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